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Abstract 

In this article it is shown bow tool vibrations of elastic joint 
robots can be reduced significantly by feedforward control 
based on inverse dynamics models. The key ideas are (a) to 
ase available algcuithnos for differential-algebraic equation 
systems to derive inverse plant models automatically and 
reliabfy, (b) to automatically construct the high-order dif- 
feientiability of the inverse plant model inputs by prefiltcr^, 
and (c) to use a controller with two structural degrees of 
freedom. The technique is demonstrated with a 6 axes elas- 
tic joint robot model and with experimental results ftota our 
laboratory robot 

1 Introduction 

A large nuniber of algorithms are known to control robots 
under the assumption of rigid joints and rigid links. Con- 
trollers designed under this assun^Mion limit die perfor- 
mance because the specialized gears used for robots, such as 
Hannonic Drives, have a significant elasticity. In particular, 
the vibrations measured at the tool are considerably higher 
as predicted with rigid joint models. This behaviour can be 
easily explained with the foUowing simple experiment: 

If only one axis of an elastic joint robot is moving so that 
gravity has no effect, the mechanical part of the robot can 
be described by the model in Fig. I . It consisu of the mo- 
ments of inertia of the motor and the load Jx the iner- 
tia of all outer joints, arras and loads projected on the axis of 
rotation), a spring^dampercombin^on describmg the elas- 



Figure 1: Model of robot axis with elastic gear. 
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Figure 2: Load dynamics with c^ttmal motor controller. 



ticity k and damping d in the gearbox, velocity dependent 
friction torques fimdhin the bearings of the load and 
the motor, as well as die motor driving torque r. AH vari- 
ables on the motor side are scaled by the gear ratio i (e.g. 
•^2 Jfnotor ' i^t © := Bmot«r/<) to eliminate the gear 
ratio equations for a simpler overall description. 

A controller should keep the deviation between the load 
angle q and the desired load angle qa(t) smaU. Most robots 
have at least a sensor to measure the motor position G. Un- 
der the assumption of a rigid joint the desired motor angbs 
Otf s and therefore the motor position error is coraiputed 
as e = Brf - B. Assuming that we have the best possible 
motor controller which is able to reduce the motor enor to 
zero all the time, die load will still vibrate due to the elastic- 
ity. 

lypical simulation resohs are presemed in Fig. 2. In tiie 
lefl part the desired speed and the actual speed of die k)ad 
are shown. In die right part die load position error is dis- 
played. Obviously, even with the best possible motor con- 
troller which is based on a rigid joint model, significant os- 
cUlatiotts occur, because the load can vibrate even if die con- 
trolled motor is at rest. 
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2 Dynamic Models of Elastic J<rint Robots 

The equations of motion for a robot having rigid links and 
flexible joints are well known and a derivation can be found 
in many articles, e.g.. in (!]. The used models mainly differ 
in the effects of the drive trains that are taken into account. 
Contrary to many models the elasticity should be modeled 
as a nonlinear spring as typical datasheets of gearbox manu- 
facturers show. Another effect often neglected is joint damp- 
ing, which is important when trying to get a realistic model. 
In this article, the following model of a robot with n axes is 
used 

0 = B(g) ^f-h 5 6 + 0(9,9) + ir(9) + 

fc(7-e) + dW-e) + /£W) (1) 
M9-e)-d(9-e) + /w(e) (2) 

where q(i) is the vector of n joint angles, 6(0 is the vec- 
tor of n motor angles, r is the vector of n driving torques 
of the motors. J is the n x n diagonal matrix of the mo- 
tor inertias, B is the n x n inertia matrix, 5 is the n ^ n 
matrix of inertial coupling between motors and links, c is 
the vector of Coriolis and centrifugal torques, g is the vec- 
tor of gravitatioDal torques and /l(9) and /m(6) represent 
the friction characteristics of link and motor beuings. The 
same notetion as in [2] is used, except that ki are nonlinear 
functions of (qi - Sj) to desCTtbe gear elasticity and di are 
nonlinear functions of Hi — 8i) to describe gear danqying 

ThfOttgkout this paper a model of the 6 axis robot 
Manuicc i3 is used as a bmchmaik. The stnictuie of the 
model equadons is aocoiding to <1,2). Sinailations are with 
respect lo a desired padi where the robot changes the posi- 
tion of all its links iimn 0 to 1 rad, starting its movement at 
time m 0.1 s. The atart and end positions of fliis movement 
are shown in Fig. 3. 




Figme 3: Benchmaifc motion for simulations with the 
Manutec r3 robot 



3 Review of Control Alg^rifliins 

The development of control strategies for elastic joint 
robots has received considerable interest in the past years. 
Overviews can be found in [3, 4]. For examine in [2] it is 
shown thai a robot with elasticities in all of it joints is lin- 
earizable by dynamic feedback. Unfortunately many of the 
proposed controllers are difficult to use in practice, e.g.. be- 
cause all robot states have to be measured or large online 
computations have to be performed. For example, even on 
the advanced DLR lightweight robot with its large computa- 
tional power it is not possible to calculate the full feedback 
linearization algorithm in real time [5]. Due to these rea- 
sons, simple controllers like 

T = ^Kp{e-ea)^Koe'^g(qi) (3) 

Si = «d -f fc-Hp(9<i)) (4) 

proposed by Tomd in [6] and variations of it are still in 
widespread use. 

The m^or drawback of this controller is that it exhibits 
laige link vibrations for foster tnyectories, as seen in Fig. 4, 
which is the result of simulations of the Manutec i3 bench- 
mark using tbe Ibmei controller. 




"^0 0.6 1 1.« 

ThmW 

Figufe4: Unkenrors for beedunarkinotiottusmg a FD con- 
troller and static compensation according to [€]. 



These vibrations are due to the fact that only torques and 
static deflections caused by gravitation are compensated in 
ttie feedforward part of the controller. This property is sufh* 
cient to gain global stability for set point control but results 
in die oscillating behavior shown in Fig. 4. From this point 
of view it is straightforward to extend the feedforward part 
of the controller by taking into account the complete robot 
dynamics to get less vibrations. This way of cakniUting the 
desired trajectories makes sense not oidy for tbe FD oon- 
trolter but also for more complex connolleis, such as state 
feedback controllers. 
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4 Feedforward Control for One Axis 

Calculating an input trajectory (here: motor angles 6^) for 
a nonlinear dynamic system corresponding to desired out- 
puts (here: q^) can be seen as an application of the theory 
of flat systems, introduced in [7]. Inputs and states of flat 
systems can be calculated from their flat outputs and a finite 
number of derivatives of the flat outputs by a system of al- 
gebraic equations. In [8] this is performed for elastic joint 
robots assuming constant stiffness and neglecting damping 
and friction. However, the calculation utilizing only alge- 
braic equations is not always possible as can be shown by 
the two mass system from Fig. 1 representing one axis and 
described by the equations: 

^i*' + /i(9) + fe(«-e)+d(ff-e) = 0 (5) 
J2^-^MB)-k(q-B)-d(g-e) = T (6) 
Given q{t) and a sufficient number of derivatives of the 
variables B(t) and t(0 shall be calculated from (5,6). When 
joint damping is neglected, <f (g ~ 6) = 0 and 8 can be com- 
puted via an algebraic equation from (5). However, when 
damping is taken into account, O is determined by the solu- 
tion of the differential equation (S). Afterwards, B can be 
calculated by solving (5) for 6. In addition, (5) needs to 
be differentiated in order to be able to calculate 6 which is 
needed for the evaluation of (6). This leads to a new alge- 
braic equation 

:(9 - 6)-!- 



dd 



Finally, r can be calculated from (6) using the previous re- 
sults. With this exannple we can already detect some neces- 
sary conditions for the application of the pioposed method: 
Doe to (7). the diaracteristic curves of spring, damper and 
link friction must be continuous and differentiable. Further- 
more, the derivatives of the desired link trajectories 94 must 
be provided up to order thxee. 

5 Inverse System Equations 

As shown by exan^le, the derivation of the inverse system 
equations may require to diffeientiate ceruin paits of the 
model equations and to solve the derived set of nonlinear 
differential and algebraic e(^iations numerically. 

It turns out that the proUem of deiennining the inverse 
system equations is ck>sety related to solve general DAEs 
(= diffeiential^lgelRaic equation systems), as pointed out 
in [9, 10], The ranauiing section will show the relationship 
formally and sketch the algorithms to transform DAEs into 
state space form, to automatically detetmine inverse models. 

A system of diflferential and algebraic equations has in 
genera] the foltowing structure: 

0 = y,ti) (8) 



where x{t) are variables which appear differentiated in the 
model (i.e.. x is present). y{t} arc algebraic and the inputs 
ti(0 are known functions of time t. This system can be 
transfomied to state space form (at least numerically) 



is] = 



/i(x,ti) 



(9) 



dy\ ^ 



(10) 



by purely algebraic transformations, if (8) can be solved for 
X and y. Due to the implicit function theorem, this is the 
case if the Jacobian with respect to these variables is regular: 

\dx 

If (10) does not hold, it may still be possible to transfomi 
(8) to a state space fonn. where the number of states is a 
subset of the elements of x. This requires to differentiate 
certam equations of (8) and to select an appropriate subset 
of x. For bodi tasks algorithms are available: The equations 
to be dififerentiated can be determined with the algorithm 
<^PantBiides [11] and the selection of state variables can be 
peifonned with the "dummy derivative method** of Mattsson 
and S6derlind [12]. Both algorithms are, e.g., available in 
the programs E^mola [13] and ABAi^JS [14]. 

Deriving an inverse model can now be treated by just ex- 
changmg the meaning of variables m a DAE: Uinv previ- 
ously unkru>wn variables Xinv or ytnv are treated as known 
input functions, and previously known input functions 
Uinv are treated as unknown algebraic variables, i.e., the 
meaning of input and output variables is exchanged. In any 
case, the result is still a DAE which can be handled with the 
same methods as any other DAE, especially with the method 
of Pantelides and the dummy derivative method. 

Since the Pantelides algorithm will diffeientiaie equa- 
tions, the known input functions may be diffenmtiated too 
which leads to the well-known effisct that the derivatives of 
the input functions must exist and be provided analytically 
up to a certain oxder, which is automatically determined by 
the algorithm of Pantelides. For this purpose several ap* 
praaches exists. Hie two most intuitive are polynomials and 
using kywpass filters of appropriate otder. Below, the latter 
method is used utilizing Butterwoxtii filters: 



By using the representation of the filter in controller 
canonical form, the derivatives of the filter output can be 
easily computed, since they are the filter states xf: 
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Figure 5: Controller with two structural degrees of freedom. 



Hence, the method consists of two steps: (1) using a stan> 
dard algorithm for link trajectory generation q4{t) such as 
"minimum travel time", (2) utilizing filters of appropriate 
order in the form of (12) to calculate the desired smooth 
link angles g/^ and their needed derivatives. 

Using the described approach is only applicable, if the in- 
verse plant model is a stable system. For linear plant models 
this means that the plant shall not have unstable system ze- 
ros, i.e., the plant needs to be a minimum phase system [IS]. 
For general nonlinear plant models it is usually difficult to 
proof that the inverse plant model is stable and therefore of- 
ten only via simulations some justification and confidence 
can be obtained. 

6 ControUen with Two Structural Degrees of 
Freedom for Nonlinear Dynamic Systems 

After designing the inverse dynamics model, the question 
arises how to combine it with a feedback controller. In 
[IS] Kreisselmeier has pfoposed and analyzed a controller 
stnictoic with two straccural degrees of freedom for lin- 
ear, single-input/single-output systems. The generalization 
of this controller stmctme to nonlinear multi-input/multi- 
output syfttcms is shown in Fig. 5. 

As discussed, the desired joint angles ga of the robot an 
filtered with a prefiUer, resulting in the filtered joint angles 
q/d and their d^ivatives q/d, • • • as input to the inverse 
robot model The inverse robot model compotes (a) the de- 
sired values yme for all measured quantities ym used in the 
feedbiKk controller and (b) an additional feedfbfwaid torque 
Ttf . In case of a FD controller G and 6 are the measured 
quantities and therefoie ymd =^ (d /d; d /d]* 

The feedback coniFoiler needs to be designed in sudi a 
way that the closed loop ^stem is globally asymptotic sta- 
ble. Assuming the inverse plant model conqmles the same 
value for y^d ^ the measured quantity ym« the control error 
e is zero. If the feedback controller starts from a station- 
ary value and the state of the controller is selected ui such a 
way that the outputs vanish, the uaputs to the robot are the 
torques rd computed m the mverse phmt model. If the in- 
verse plant model is identical to the robot model, the robot 
will fxoduce i/m — Vmd (because the inverse plant model 
was constructed in this way) and the preliminary assump- 
tion of zero control error is fulfilled. In other words, the 
controller has no effect, as long as the plant and ilie inverse 
plant model are identical, ihey both start at the same initial 
values and both systems are stable. 

If this is not the case, a control error occurs and the con- 



troller has to stabilize the system and cope with the impre- 
cise inverse plant model. This controller structure is advan- 
tageous because the design of the feedback control to stabi- 
lize the plant is decoupled from the feedforward control that 
is responsible for following the given reference input. Note, 
that the prefilter deternunes essentially the input/output be-- 
haviour q^^q of the overall system, siruie the inverse plant 
model and the plant model cancel each other, and therefcwe 
it can be interpreted as the **desired transfer function" of the 
closed loop system. 

7 Simidation Results 

A model of the Manutec r3 robot has been implemented, in- 
cluding the 3-dimensional mechanics and drive trains with 
flexibility in every joint, using the free, object-oriented mod- 
eling language Modelica [16, 17}. Simulations have been 
performed with the Dymola program [ 1 3}. The highest level 
of the robot model is shown in Fig. 6. 




1^ 



IHgure 6: Moddica model of die Manutec r3 Robot 
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On the left side, the motor driving torques are pxovided as 
an input signal vector which is split into inputs to the 6 mo- 
tors of the robot. The motors are mounted on the appropri- 
ate parts of the robot The output shafts of the motors arc 
rigidly connected to the gearboxes, which contain elasticity, 
damping and friction. The output shafts of the geaiboxes 
are rigidly attached to the driving axes of the revolute joints 
of the mechanical part. Finally, the angles of the joints are 
extracted, collected and provided as one output signal vec- 
tor on the right side of the figure. This model of the robot is 
used for simulations as well as for deriving the inverse robot 
model. Fig. 7 shows the inverse robot nnodel. 




I^gure 7: Modelica model of invo-se dynamics. 



In the right part of this figure, the model of the robot firom 
Fig. 6 18 used. In order to derive the inverse robot model, 
only the inpuis and outputs of the robot model have to be 
exchanged, which is achieved by the TNvoIn and TwoOut 
blocks. As a result, the joint angles q are input signals to 
the robot model and the motor torques are output variables. 
In addition, the joint angles and their derivatives need to 
be defined. This is accomplished by Butterworth filters as 
explained in Section 5, see left part of Fig. 7. Translating 
this model with Dymola, produces the inverse robot model. 
Figure 8 shows the feedforward torques of the first three 
axes computed for the benchmark example. 

The inverse robot model is used in combination with a 
FD controller in simulations to verify the performance im- 
provement. As expected the path deviations are zero except 
for small numerical errors, if exactly the same model is used 
for the plant and the mverse plant model. A more mterest- 
ing question is whether the feedforward control is still use- 
ful when the inverse robot model deviates firom the robot 
model. For a simple test, simulations have been perfomned 
with the robot load being half and double the expected load. 
The results are shown in Fig. 9. When comparing Fig. 4 
with Fig. 9 it can be seen that the path errors with the un- 
precise inverse robot model are still one order of magnitude 
smaller than those caused by the PD controller using only 
stttic compensation. 

A drawback is the quite large amount of computing time 
that is needed to calculate the inverse dynamics. On a Pen- 




Jt 




Figure 8: Feedforward torques of the first three axes com- 
puted fiDr the benchmark example. 

tlum m with 700 Mhz it takes about 12 seconds to calcu- 
late Che feedforward control for a trajectory lasting 1 sec- 
ond with integration algorithm DASSL. The major reason 
is, that a detailed model with damping is treated and that the 
motors are mounted on the links and are not approximated 
to be placed on ground, as it is often assumed. As a conse- 
quence, part of the equations of motion need to be differen- 
tiated up to order eight. Furthermore, nonlinear differential 
equations need to be solved. When taking into account that 
the code generated by Dymola is highly optimized, it seems 
difficult to evaluate the complete dynamics model online. 
However, it is possible to compute the time consuming part 
of the feedforward control off-line since it is sol^y based on 
the known desired inputs, save the result and use [ymiii 
as inputs to the feedback controller. 
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Figure 9: Link errors for Benchmark motion wiA inverse 
robot model. Full: optimal model, dashed: double load, 
dash-dot half toad. 
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8 Experimental results 

In order to verify the results obtained through simulation, 
tests with our laboratory robot have been carried out. The 
desired trajectory was chosen to be a square with start point 
[-100,0,0]nun traversed m clockwise direction. Figure 10 
shows absolute deviations from the desired path displayed 
on the z axis. As can be seen the deviations are reduced 
significantly compared to the controller without the inverse 
robot model. 




Figure 10: Path deviations with controller using inverse 
robot model compared to standard controller. 

9 Conclusions 

This paper pointed out that controllers for elastic joint robots 
can be improved considerably by extending diem with an in- 
verse dynamics feedforward controller. It turns out that even 
very con:q)lex inverse dynamics models can be generated au- 
tomatically and reliably using algorithms for handling of 
differential-algebraic equations e.g. available in the pro- 
gram Dymola. Simulations and experimental results show 
the effectiveness of the proposed method. 
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